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HANDLES 

variables: enable-time, disable-time 
* 

if (NOT error) ( 

right-handle is ui -right-handle 
left-handle is ui-lef t-handle 

if (right-handle OR left-handle) { 
disable- time is FALSE 
time-disabled is FALSE 
if (NOT enable- time) 

enable- time = current time 
time-enabled = current time - enable- time 

} 

else( 

enable- time is FALSE 
time-enabled is FALSE 
if (NOT disable-time) 

disable-time = current time 
time-disabled = current time - enable- time 




} —7 az-v^ 

enabled is (right-handle OR left-handle) J~~ 



) 

else( 

enabled is FALSE 
right-handle is FALSE 
left-handle is FALSE 
time-enabled is FALSE 
time-disabled is FALSE 

) 
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ERROR 

•Mow level software filters the hopper full sensor** 

if (ui -hopper-missing OR ui- tank-over fow OR ui- tank-empty OR system-error) 2-3*°^- 
error is TRUE | 
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DISTANCE ....... 

variable: burnish-distance, squeegee-distance 

if(scrub-cmd AND scrubbing) { D — 2.&$^- 
if(NOT burnish -distance) — 
burnish-distance =0 / 
else 

burnish-distance = burnish-distance + omu 
^ DistanceFunction( right-drive-speed, left-drive-speed, rate) — ^ 

else 

burnish-distance = FALSE J 

i f ( s c r ubbiffg ) ^-r 

squeegee-distance = FALSE -XftOo 

squeegee- time = FALSE J 

else r* 

if (NOT squeegee-distance) / 

squeegee-distance =0 |— 2^0 o 

squeegee-time = current time * squeegee- timeout "l a?S\0 

else u 

squeegee-distance = squeegee-distance + 1 aAH_ 

DistanceFunction(right-drive-speed, left-drive-speed, rate) 

if (squeegee- time) { jg/^t 
if ((squeegee-distance > safe-distance-to-squeegee) OR 
(current-time > squeegee- time) ) 
squeegee-safe is TRUE 
else 

squeegee-safe is FALSE 

} 

if (burnish-distance > safe-distance-to-burnish) 

burnish-safe is TRUE 
else 




CONTROL 



•"sweep, scrub, and burnish buttons polled at low level** • 1- J 



sweep-cmd is ui-sweep-cmd 
scrub-cmd is ui-scrub-cmd 
burnish-cmd is ui-burnish-cmd 
speed = ui -speed 



it 



drive-enabled is {enabled AND (NOT (sweep-end XOR sweeping)) AND (NOT(scrub-cmd 7 'za**- 
XOR scrubbing) ) ) J 



DRIVE 



**run at speed-ramp-rate times per second** 
( 

if (right -wheel- target-speed is NOT right-wheel-current-speed) 

right-wheeT-current-speed = right-wheel-current-speed * minimum of 

speed-ramp-s tep 
(right-wheel- target-speed 

whee 1 - current- speed ) 

if (left-wheel- target-speed is NOT left-wheel-current-speed) 

left-wheel-current-speed = left-wheel-current-speed + minimum of: 

speed- ramp- step 

(left-wheel- target-speed - left- 
wheel-current -speed) 

right-drive-speed = right-wheel-current-speed 
left-drive-speed = left-wheel-current-speed 

} 

if (drive-enabled AND (NOT error) ) ( 
if (left-handle) 

right-wheel- target-speed = ConvertSpeedFunct ion (speed) 
else 

right -wheel-target-speed = speed-wheel-stop 
if (right-handle) 

left-wheel- target-speed = ConvertSpeedFunction( speed) 
else 

■left-wheel- target-speed = speed-wheel-stop 



- right- I j,"7oO- 
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if (right-handle OR left-handle) 
if (NOT driving) 
driving is TRUE 

else 

if (driving) 
. driving is FALSE 

} 

else ( 

right-wheel-t^rget-sp*«d * speed-wheel-stop 
left-wheel -target-*pi«d =» speed-wheel-stop 

if (driving) 

driving is FALSE 
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if(sweep-cmd AND (speed is NOT reverse) AND (NOT error) ) { [ 2So7_ 
if (time-enabled > delay-on-sweep-start) — ' 
if (sweeper is off) 
turn sweeper on 
if (time-enabled > delay-on- sweep- lower) 
if (sweeper is up) 
sweeper to down 
else 

if (NOT sweeping) 
sweeping is TRUE 
if (time-disabled > delay-off -sweep-raise) 
if (sweeper is down) 
raise sweeper 
if (sweeping) 
sweeping is FALSE 
if (time-disabled > delay-off -sweep-stop) 
if (sweeper is on) 
turn sweeper off 

} 

else( 

if (sweeper is down) 
sweeper to up 
if (sweeping) 

sweeping is FALSE 
if (sweeper is on) 
turn sweeper off 

} 



if (scrub-cad AND (speed i* NOT reverse) AND (NOT error)) 
if (time-enabled > deiay-on-ecrub-start) ( 
if (shroud is closed) 

open shroud 
if (scrubber is off) 

turn scrubber on 
if (vacuum is off) 

turn vacuus on 
if (squeegee is up) 

lower squeegee 
if (solenoid is closed) 

open solenoid 

} 

if (time-enabled > delay-on-scrubber-low«r) ( 
if (pump is off) 

turn pump on 
if (scrubber is up) 

lower scrubber 
else 

if (NOT scrubbing) 
scrubbing is TRUE 

) 

if (time-disabled > delay-off -scrubber -raise) ( 
if (scrubber is down) 
raise scrubber 
JLf (scrubbing) 
scrubbing is fALSX 
if (pump is on) 
turn pump off 

) 

if (time-disabled > dslay-of f-scrubber-stop) ( 
if (scrubber is on) 

turn scrubber off 
if (solenoid is open) 

close solenoid 
if (squeegee-safe) ( 

if (shroud is open) 

close shroud 

if (squeegee is down) 

raise squeegee 

if (vacuum is on) 
1 turn vacuus off 
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! ) 
} 

else( 

if (scrubber is down) 

raise scrubber 

if (scrubbing) 

scrubbing ■ PALSS 
if (pump is on) 

turn pump off 
if (scrubber is on) 

turn scrubber off 
if (solenoid is open) 

close solenoid 

if ((speed is reverse) OR error) ( 
if (shroud is open) 

close shroud 
if (squeegee is down) 

raise squeegee, 
if (vacuum is on) 

turn vacuum off 

) 

else if (squeegee-safe) ( 

if (shroud is open) 

close shroud 
if(squeeg«« i« down) 
raise squeegee 

if (vscuua is on) 
turn vacuum off 
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BURNISH 



if (burnish-cmd AND (speed is NOT reverse) AND (NOT error) ) { 
if (time-enabled > delay-on-burnisher-start) ( 
if (burnisher off) 

turn burnisher on 
if (burnish- 5o\v- <-. AND driving) { 
if (burnisher NOT down) 
^ burnisher to down 
else 

if (NOT burnishing) 
burnishing is TRUE 

( 

else 

if (burnisher NOT at middle) 
burnisher to middle 

} 
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if ( (time-disabled > delay-of f-burnish-stop) OR (NOT driving) ) { 
if (burnisher is down) 

burnisher to middle 

if (burnishing) 

burnishing is FALSE 
if (burnisher is on) 

turn burnisher off 

} 

if (time-disabled > delay-off-burnish-raise) 
if (burnisher NOT up) 



burnisher to up 

else( 

if (burnisher is down) 
burnisher to up 
if (burnishing) 

burnishing is FALSE 

if (burnisher is on) 
turn burnisher off 

} 



